' XP-002570457 & ^ 3 ^ (£) 
Accurate Motion Controller Design Based on an Extended Pole Placement Method 

and a Disturbance Observer 

Hendrik Van Brussel (1). Chwan-Hsen Chen, Jan Swevers* 
Katholieke Universiteit Leuven, Department of Mechanical Engineering, Celestijnenlaan 300 B, 3001 Heverlee, Belgium 
* Senior Research Assistant with the N.F.W.O. (Belgian National Fund for Scientific Research) 

Received on January 14, 1994 

Abstract 

The paper describes an innovative integrated design method for accurate tracking in motion control 
applications, in the presence of external disturbances like friction, cutting forces, etc. 
First, an extended pole placement method is developed to design feedforward controllers for applications 
with known future input commands, like in feeddrives for machine tools. It results in a noncausal reference 
model with a low-pass characteristic with selectable bandwidth and zero phase shift. A new feedback 
design approach, based on a state and disturbance observer is introduced. A loop transfer recovery 
procedure tunes the observer gains to compromise optimally between performance and robustness. 
Keywords: Automation, Continuous path control, Algorithms 



1 Introduction 

The complex shapes involved in modern product designs and the 
ever increasing pressure for higher productivity call for a drastic im- 
provement of the dynamic behaviour of the motion control systems 
in future production machinery. The complex work piece surfaces, 
generated by CAD-systems, are to be transformed, as accurately 
as possible, into toolpaths for machine tools or into end effector 
trajectories for industrial robots. The more discontinuous these 
tool paths are and the higher the machining speed requirements, 
the higher the acceleration requirements are on the motion control 
systems and the more difficult the required tracking accuracies to 
be met. With the advent of new production processes, like energy 
beam machining, the normally used tricks, like slowing down at 
sharp corners, are not acceptable due to the danger of overburning. 

Traditional P I D-cont rollers have to compromise between good po- 
sitioning behaviour and high tracking accuracy. They completely 
ignore the dynamic effects resulting from fast varying reference 
commands and therefore they are unsuitable for high-speed con- 
touring and cornering applications. 

Two main functions can be distinguished in a motion control sys- 
tem; feedforward and feedback. Feedforward makes the controlled 
system (as much as possible) equal to the desired system, thereby 
using future information. An ideal feedforward makes the system 
output position follow exactly the input reference command. Feed- 
back control utilizes the measured position information to make 
the output motion equal to the desired motion, in spite of the 
presence of modelling errors and external disturbances. 

In this paper, a novel integrated motion controller design method- 
ology is developed, featuring an innovative feedforward controller 
and a robust feedback controller based on a disturbance observer. 

Rapidly varying reference commands make the use of feedforward 
information indispensible for reducing tracking errors. The impor- 
tance of using future commands to enhance servo performance has 
long been recognized [13]. Existing methods like General Predic- 
tive Control (GPC) [4j, and cross-coupled control [9] also implicitly 
incorporate feedforward control. In this paper, a so called extended 
pole placement method is developed to design servo feedforward 
controllers for applications with known future commands, like in 
feeddrives for machine tools. It results in a noncausal reference 
model with a low-pass characteristic with selectable bandwidth 
but zero phase shift. It uses a finite-impulse-response (FIR) filter 
for its uniform frequency response and zero phase errors. By this 
method, the resulting output motion resembles almost perfectly 
the command input. Zero phase shift is important for coordinated 
motion along multiple axes. Also important is that it provides a 
feedforward input with selectable bandwidth, important in order 



not to excite hidden system resonances, a feature which existing 
algorithms ignore. 

In motion control systems, integral feedback control is the prevail- 
ing method to remove steady- state positioning errors and to cancel 
out the influence of external disturbances. It however deteriorates 
system response and incurs instability. Disturbance observers are 
regarded as a promising prospective substitute for integral control. 
What is lacking, however, is a systematic design method, for sys- 
tems with more states than output measurements, that results in a 
design achieving a balance between robustness and performance. 
The new feedback design approach, presented in this paper, is 
based on the Kalman filter concept, which expresses uncertain- 
ties in the mathematical model and the measurements in terms of 
their covariance values. However, instead of having to determine 
explicitly numerical values for the covariances, the problem is ap- 
proached from the side of robustness considerations, represented 
by the maximum singular value of the system loop transfer func- 
tion. A dynamic model for the disturbance is presumed and the 
Doyle- Stein loop transfer recovery (LTR) procedure is applied to 
tune the disturbance observer gain for optimal system robustness. 
Without sacrificing response bandwidth, the low-frequency distur- 
bance rejection can be significantly improved, with a performance 
that integral control can hardly compete with. 

These two new approaches result in an innovative controller design 
methodology. Besides the feedforward and the feedback parts, 
the control structure also contains a reference state generator, 
which also has an observer-like structure. The resulting controller 
has a high performance. Although the potential of the resulting 
controller can already be seen from the example of a machine 
tool slide, given here, its merits can be fully appreciated when 
designing controllers for high-order systems, like motion control 
systems with structural flexibility (e.g. robots, high-bandwidth 
machine tool feeddrives). 

2 Feedforward design: the extended pole placement 
(EPP) method 

Consider a motion control system, with a structure indicated in 
figure 1, subject to a reference input trajectory y Tf/ and produc- 
ing an output trajectory y. The control input to the system is u; 
the discrete transfer function of the open-loop system, relating u 
to y is given by 

*M-5jg. (i) 

Numerator B(z) can be factorized as 

B(z) = B+(z)B~{z) = B+{z)Bi MP (z)BZ P {*), 

where B'(z) includes the so called uncancellable zeros, i.e. those 
outside the unit circle, also called the nonminimum-phase zeros 
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(Bnmp(z)) and the very lightly damped zeros (B^ P (z)). 
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Figure 1: Structure of the controlled system 

A servo controller, designed according to the pole placement meth- 
od, generates a control input according to the following control 
law: 

R(z)u{k) = T(z)y T9f (k) - 5(z)y(fc). (2) 
The desired closed- loop transfer function, which is called the "ref- 
erence model" , is given by: 



Vrc/(fc) 

Combining equations (l)-(3) yields: 



(3) 



*./(*)• (4) 



(5) 



The feedforward function T(z) determines the servo performance 
of the closed- loop system defined by reference model H rt j. After 
completing the feedback design, H re / simplifies to [2]: 

B'(z)T{z) 

where A 0 {z) represents a low-pass filter to trade off between closed- 
loop performance and noise sensitivity [2]. Remark that ff rm /(z) 
contains B"(z) in its numerator. 

The ideal reference model is, of course, Href — 1. in which case 
there is no distortion nor phase shift between y re j and y. This 
requirement would yield the following feedforward function: 



T(z). 



A.{z)A m (z) 
B-(z) 



(6) 



rf B~(z) contains nonminimum-phase (NMP) zeros, gathered in a 
factor B# MP (z), the feedforward function T(z) becomes unstable. 

To solve the problem of the unstable feedforward function T(z), 
we propose to approximate l/B„ MP by its truncated Taylor series 
expansion. 

For example, when B£ MP = (z-a)/(l-a) and |o| > 1, \/B„ MP 
is approximated by the series 



Bsmp 



NMP- 



(7) 



Except for zeros very close to the unit circle, a few polynomial 
terms in Eq. 7 are sufficient to give an accurate approximation 
to 1/B# MP . Since Eq. 7 contains polynomial terms with positive 
indices, the resulting feedforward transfer function is always stable. 



2.1 Noncausal finite-impulse-response filter 

The feedforward function T(z) includes the MP zero factor B^ P 
of B" in order to directly cancel the open-loop transfer function 
zeros. Including B^ P in the denominator of T(z) can give violent 
feedforward signals when the zeros in BJ^ P are close to z = — 1. 
Since most closed-loop systems behave like a low-pass filter, vi- 
olent feedforward signals can also result from the fact that their 
inverse models would greatly amplify the high frequency spectral 
contents in the commands. This side effect can be remedied by 
extending Eq. 6 with a noncausal windowed low-pass FIR filter. 



which attenuates the feedforward function gain at high frequen- 
cies without any phase lag: 



i-0 



+ O- 



(8) 



w x is a Hamming window like function and suppresses the ripples 
of the high order FIR filter near to the cutt-off frequency. This 
filter has zero phase angle because the phase lead generated by z % 
compensates the phase lag generated by This noncausal filter 
can be used in most applications where future reference commands 
are available. 

The complete feedforward transfer function T(z). expressed in 
Eq. 6, now becomes: 



(9) 



in which B^f P /^^ MP is an approximation of l/8~. and ^TTR >s 
added in order to attenuate the high frequency gain of the feed- 
forward controller. The actual control algorithm implemented in 
the digital computer can be obtained by substituting Eq. 9 into 
Eq. 2. 



2.2 Experimental verification 

The experimental test setup is a ba Use rew-d riven machine tool 
slide. Its experimentally identified discrete- time transfer function 

is: 



H(*) 



1.816 x 10" 3 (z + 0.9599) 
(z - l)(z - 0.8842) 



B+{z)B-(z) 



It describes the relation between the input u(fc), in digital-to- 
analog converter units, and the encoder output y(k) for a sampling 
frequency of 250 Hz. The pitch of the ballscrew is 10 mm/ rev, and 
the encoder resolution is 400 counts/rev. Together, they make a 
basic length unit (BLU) of 0.025 mm. 

The required closed-loop response is specified by the characteristic 
polynomial A m (z) « z 2 - 1.2589* + 0.4604, which is equivalent 
to a closed-loop bandwidth of 21.68 Hz and a damping ratio < of 
0.712. These poles are determined using optimal feedback control 
(see further), which uses weighting between the control effort and 
the output error. 

The feedback function R(z) includes an integrator in order to have 
high low frequency servo stiffness. The uncancellable, but stable, 
zero at z — -0.9599. is included in B^ P (z) = 1.816 x 10" 3 (z + 
0.9599). B+{z) = 1. 

Based on the traditional pole placement feedback design procedure 
(see e.g. (2) for details), thereby trying to maximize the distur- 
bance rejection ability, white keeping the noise response transfer 
function, relating the measurement noise e(k) to the output y(k) 
below unity at frequencies above the closed-loop bandwidth, fol- 
lowing polynomials result: 

R(z) « z 2 - 1.323* + 0.323 
S(z) » 69.143* 2 - 125.647z + 57.324 
A*(z) = z a - 1.823* + 0.837, 

where the bandwidth of the polynomial A Q is bHz. 

The reference model for the servo control system is a 13th order 
FIR filter with a 31 Hz bandwidth, windowed by the Hamming 
function. The bandwidth of the FIR filter is chosen in order to 
avoid the excitation of a known resonance of the slide around 
40/Yz. 

The X-Y positioning table contour described in (7] is used in order 
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Figure 2: Contouring experiments with the ZPET+E-filter 
and the EPP methods 

to verify the tracking accuracy of the EPP method. The contour 
consists of a straight line of 25.4mm raising 30° from the X-axis, 
immediately followed by a circular arc with a radius of 25.4mm. 
extending 60° to the Y-axis (figure 2). 

The performance of the EPP controller is compared with the per- 
formance of a controller designed by the E-ZPET method [7\. 
Figure 3 shows the resulting reference models for both methods. 
Both transfer functions exhibit unit gain in the low frequency re- 
gion, but the bandwidth of the E-ZPET controller, which cannot 
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Figure 3: Frequency responses of H T9f (z) for the E-filter en- 
hanced 2PET method and the EPP method 

be specified and extends to 100 Hz, while the bandwidth of the 
EPP method extends to 2SMz (which is about the closed-loop 
bandwidth). 

The large transient errors at the starting and the cornering points 
of the contour (figure 2) indicate the over-compensation of the 
E-ZPET algorithm. The EPP controller gives lower overall track- 
ing errors (figure 4) than the other controller due to the direct 
inclusion of Bj^ P (z) in the feedforward function T(z) (Eq. 9) in 
order to give a more accurate approximation of the inverse closed- 
loop transfer function. 
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Figure 4: Position error for the ZPET+E-filter and the EPP 
methods 

3 Feedback controller design with disturbance observer 

Unaccounted external disturbances and modelling errors are rather 
rule than exception in motion control applications. Coulomb fric- 
tion and stiction forces always exist in mechanical interfaces like 
bearings, so do cutting forces in machine tools during metal re- 
moval operations. Modelling errors stem either from an incomplete 
model or from varying loads on the controlled system. If these 
disturbances and errors are not accounted for in the feedback con- 
troller design, they give rise to tracking errors during contouring 
and nonzero steady-state errors during positioning. 

Since the 40's ( integral control has been the de facto approach to 
remove steady- state errors in most controller designs. Although 
its wide acceptance in practice, one persistent problem with in- 
tegral control is its adverse effect on servo performance and ro- 
bustness. For high-performance motion control applications, it is 
necessary to find a replacement for integral control which retains 
robustness and performance while enhancing disturbance rejection. 
The use of a disturbance observer is proposed here as a valuable 
alternative. 

The idea behind the disturbance observer is to detect external 
disturbances acting on a controlled system by comparing the pre- 
dicted outputs from a system model with the measured outputs. 
A high-quality disturbance observer design should satisfy follow- 
ing requirements:(i) be applicable to multiple-output measurement 
systems, to take advantage of the multiple sensors to give more 
reliable estimations of the disturbance; (ii) provide a methodology 
to find the observer gains which can preserve both performance 
and robustness of the closed-loop system. 



3.1 Formulation of the disturbance observer 

Consider a single-input-multiple-output system represented by its 
discrete state space model: 



{ 



sBfc+i = *a8jk + ru k + rd k 
y k * Cat + 14, 



(10) 



with measured outputs y*. The process disturbance d k enters the 
system together with the control input u*. To model the dynamic 
behavior of the expected disturbance, we presume that the external 
disturbance is generated by a stochastic dynamic process described 
by 

d* + ! « * d . d k + W*Jk % (11) 
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which is excited by white noise Wd, k . Both systems can be merged 
to form an augmented system 

(12) 

The augmented system is controlled by a linear feedback controller 

with feedback gain K, and an additional term d k to compensate 
external disturbance d k . x k and d k are the estimated state and 
disturbance. The observer for the state and disturbance has the 
standard observer structure. 

Having decided the structure of the controller, one question we 
are immediately confronted with is to choose the gain values K 
for the feedback control and the gains for the state and distur- 
bance observer which can meet our requirements on disturbance 
rejection and robustness to model parameter variations. Most 
literature suggests the pole placement method for the controller 
and observer design. However, this approach often leads to very 
poor robustness [5]. Therefore it would be preferrable if we could 
find the observer gain which does not incur robustness loss in the 
closed-loop system. This can be achieved with the so called loop 
transfer recovery (LTR) method. 

The LQG/LTR method was formulated in an attempt to regain the 
excellent stability margins associated with LQ regulators that are 
lost when a Kalman filter is introduced in the LQG- formulation. 
It is only one of several alternative methods, like H^-, and 
/i-syn thesis [5], but it has the advantage of guaranteeing excellent 
robustness. 

To obtain a balanced design between robustness and performance. 
Doyle and Stein developed an adjustment procedure to tune the 
observer dynamics which is always stable and will gradually recover 
the loop transfer function of LQ-control (which is known to be 
more robust than the LQG-design). 

The LTR procedure assumes a Kalman filter structure for the ob- 
server, then adds a fictitious disturbance vector tb to the plant in 
the form 

to = rl\ (13) 

with covariance 

R* 2 E {& ib T } = r 2 r"r , ( 14) 

where r is a real number. Outputs y are assumed to be subject to 
noise u with intensity R„ = E {v > i/ r ). By gradually increasing 
the intensity of the fictitious disturbance toward infinity, r — » oo, 
the loop transfer function of the associated LQG controller will 
converge to that of the LQ controller. 

Before applying the LTR method to the disturbance observer de- 
sign, we reformulate the extended system in Eq. 12 and add the 
fictitious disturbance w = r • r needed in the LTR procedure to 
give 

where R** = E {w* • u*J} is the intensity of external disturbance 
W4 yet to be determined. The covariance of the measurement 
noise can be obtained from the sensor resolution with a presumed 
probability density function such as the Gaussian distribution. 

Since it can be shown that the disturbance observer gain does 
not affect the resulting controller's poles, we may first apply the 



LTR procedure to the original system model (Eq. 10) without the 
disturbance state d k and increase the intensity of the fictitious 
process disturbance Tr to drive the state observer poles to con- 
verge. With the obtained intensity r^. we apply the LTR proce- 
dure again to the extended system in Eq. 15 and gradually increase 
disturbance intensity W4 as long as the maximum singular value 
&(T(u/)) does not increase significantly beyond the closed-loop 
bandwidth. Since we assume that maximum singular value a(T) 
has been determined by the allowable variation cf(A) in the feed- 
back design stage, it should not be further reduced, especially at 
frequencies beyond the closed-loop bandwidth. 

3,2 Experimental verification 

To verify the disturbance observer scheme, the same machine tool 
slide mentioned above for feedforward control experiments is used 
here again. The slide system has a discrete-time state-space model 

/ P \ _ f 10 0.0526 1 / p \ f 0.0018 1 
\ v j M " [ 0.0 0.8842 J \ v f+X 0.0637 J tt * 

(16) 

c 

identified at 250 Hz sampling frequency. 

Using the LQ- method to find the state feedback gain K t we for- 
mulate the objective function J: 

that includes the output position and the control input weighted 
by a positive number p. The constant feedback gain K which 
minimizes the objective function J satisfies an algebraic Riccati 
equation. The resultant poles of the closed-loop system are the n 
roots within the unit circle of the 2nth-order dynamic system 

p+H(z- 1 ) H(z)^0 l 

where H(z) is the transfer function matrix from input u to position 
output p. The closed-loop poles shift from the open- loop poles 
toward the zeros as the control weight p decreases. The damping 
ratio of the resultant closed-loop system is greater than 0.7 as 
long as the closed-loop bandwidth is less 50 Hz. Therefore, it is 
not necessary to include the velocity v as penalty in the objective 
function to increase the damping ratio of the closed-loop system. 

The discrete-time LQ controller has a finite gain margin 0 between 

TT71 - 0 - 1^7?' 

for uncertainty in the control input matrix 0T [2]. For the slide, 
the gain margin 0 of the closed-loop system reduces as the band- 
width of the closed-loop system increases. We choose a closed- 
loop bandwidth of 21 .7 Hz with feedback gains K = [56.63, 8.21J 
in order to retain a sufficient gain margin 0 - (0.58, 3.59], or 
equivalently 

[-4.72, 11.11) dB. in the control matrix. 

Although all states of the slide table system are directly measured, 
we still use the Kalman filter to estimate the velocity, the position 
and the external disturbance in order to attenuate measurement 
noises and compensate for the disturbance. 

The measurement noise for position u p and that for velocity </ v are 
assumed to be uncorrected, and their respective variance values: 
Ru, v for velocity and R^j, for position measurement noises are 
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The variance of position measurement noise R„^ is based on a 
uniform probability density function which is centered at the en- 
coder reading and extends midway to the adjacent readings; the 
variance of the velocity measurement R vv is purposety increased 
to account for the voltage ripples in the tachometer output and 
its multi-stage conversion (tachogenerator — * attenuating ampli- 
fier — • A/D converter). However, only their ratio is important to 
the Kalman filter design. 

Two disturbance variances are yet to be assigned before apply- 
ing the LTR technique: one for the fictitious disturbance with the 
same input matrix, i.e. to = nT, the other with a presumed con- 
stant R V)4 to represent the undetermined intensity of the external 
disturbance. 

We apply the LTR technique to the state-space model first without 
disturbance dynamics to find the limiting magnitude of the ficti- 
tious disturbance that makes the resulting loop transfer func- 
tion from the system input u* to the controller output u k = -Kit 
gradually converge to that of the full state feedback system from 
system input u to controller output &* m — Kx k , which means 
the loop transfer function of LQG control is recovered to that of 
the LQ control. 

With the obtained intensity R# t ao «■ 10 6 , we iterate with increas- 
ing disturbance intensity R W4 and monitor its maximum singular 
value a(T) to find the maximum value of K*, which does not 
reduce the gain margin 9(A) of the resultant closed- loop system 
significantly. In order to preserve enough robustness margin, in- 
tensity of the external disturbance is selected to be 2 x 10 s which 
hardly decreases the maximum singular value at frequen- 

cies above 20Hz. The resultant gain for the observer corresponds 
to observer poles at 0.00, 0.759, and 0.956 for position, .velocity, 
and disturbance respectively. This pole pattern is quite different 
from that of the Butterworth filter. 

To verify the performance of the disturbance observer, a trajec- 
tory consisting of a smooth 9 reorder spline [16] is tracked by this 
disturbance-compensated LQG controller. The peak velocity of 
the motion profile reaches 220 mm/ sec at the middle of the tra- 
jectory where the motor reverses its torque direction. The same 
trajectory is also tracked by an integral LQG controller with the 
same feedback gain for comparison. The integral gain *j = 0.9 
is obtained by tuning the integral control gain to give the least 
tracking errors with little oscillation after the slide reaching the fi- 
nal position. Both controllers use the same feedforward algorithm 
and the same feedback gains. 

Tracking errors and controller output for both controllers are il- 
lustrated in figure 5 and figure 6, respectively. As shown in 
figure 6, the input voltage to the servomotor almost reaches 
the maximum output voltage (50 volts) of the amplifier. From 
experiments we performed to identify the system model, the sys- 
tem model deviates significantly from the real system behavior in 
this output region. However, even at high tracking velocity the 
disturbance-compensated LQG control shows no oscillations in its 
controller output and the final position after reaching the desired 
position (figure 6 and figure 5). The disturbance-compensated 
controller also gives smaller overall errors than the integral LQG 
control. 

Comparing the estimated disturbance and the output of the inte- 
grator, the amplitude of the integral output is much larger than 
that of the estimated disturbance due to the fast accumulation of 
the output errors at high-velocity tracking. A larger integral out- 
put can easily saturate the actuator and cause numerical overflow 
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Figure S: Tracking errors of the disturbance-compensated LQG 
control and of the integral LQG control during the tracking 
experiments 

in the digital processor. Usually, the integrator requires a longer 
word-length storage [2] in fixed- pointed controllers to avoid over- 
flow and special precautions to avoid saturation and terminal os- 
cillations in practical implementations. However, the disturbance 
observer can be directly implemented in the controller without any 
modification, and the estimated disturbance can be a useful infor- 
mation for system diagnostics. For example, the estimated distur- 
bance in the cutting tool feedrate controller for machine tools can 
indicate the cutting force. Excessive cutting force, or sudden drop 
in the cutting force may indicate a worn, or broken tool. 
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Figure 6: Outputs of the integral LQG and the disturbance- 
compensated LQG controller during the tracking experiments 
of the slide 

4 Global control scheme 

The feedforward signal uj is added to the input of the closed- 
loop system to compensate for the non-zero reference input com- 
mand y Tt j. Consequently, the feedback controller only has to take 
care of the deviations from a zero-input response. This scheme 
can only work when the estimated state x is also reduced to a 
zero-input- state. This can be done by subtracting from x the so- 
called reference state x rt / which occurs due to the reference input 
Vrtf The reference state could be generated by a model with an 
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observer-like structure (3) as 



(18) 



to ensure that the resulting reference state vector is com- 
patible with reference output y^j and no difference at the steady 
state. 

Observer gain £ rcf is obtained by assuming measurement noise u nf 
and process disturbance 10^ = rw n t and applying the Kalman 
fitter design method to the following model : 



S/ref.fc = Cx mJt + i/ tetM 



(19) 



The variance of t/ n j represents the round-off errors in computation. 
The process disturbance w represents the errors in u/ resulting 
from the inexact inverse feedforward transfer function (Eq. 9). 
However, only their relative values can affect the resultant Kalman 
filter gain. Although we are free to select a high gain L nt to 
keep the reference states closely following the desired output, but 
to avoid generating reference states difficult to track or exciting 
unmodelled resonances, we should select the observer poles around 
the closed-loop bandwidth. 

The three parts of the controler: feedforward, feedback and refer- 
ence state generator can now be assembled together in a powerful 
general control scheme shown in figure 7. 



5 Conclusion 

By combining a noncausal filter in the feedforward path in an 
extended pole placement method with the use of a disturbance 
observer in the feedback path, a high performance motion control 
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Figure 7: General control scheme 

design system is obtained leading to minimal tracking errors, maxi- 
mal robustness against model errors and external disturbances and. 
very important, a selectable bandwidth of the closed-loop system, 
enabling to avoid excitation of unmodelled resonances. 
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